float q[4]   "quaternion"
float rpy[3] "euler angles"
